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ABSTRACT 


Autonomous  Underwater  Vehicles  (AUV's)  are  being 
considered  for  a  diversity  of  U.S.  Navy  missions.  They 
protend  the  advantages  of  cost  effective  fleet  multiplica¬ 
tion,  minimal  detectability,  and  reduced  risk  to  personnel 
and  high-value  fleet  assets.  In  response  to  the  Department 
of  the  Navy  and  DARPA  interests,  AUV  research  and 
development  by  a  number  of  public  and  private  sector 
organizations  has  intensified  in  recent  years.  The  Naval 
Postgraduate  School  has  now  built  the  first  of  a  series  of 
AUV  models  which  will  be  used  as  "test-beds"  for  evolving 
automated  control  technologies.  This  thesis  documents  the 
results  of  initial  efforts  to  install  an  on-site  facility  to 
support  the  design  and  development  of  a  model-based  digital 
autopilot  for  control  of  the  NPS  test  vehicle.  Using  an  IBM 
PC/AT  and  analog-digital  interfacing,  the  development 
methodology  has  been  implemented  and  verified  by  a 
simplified  model  reference  control  program  for  AUV  dive 
plane  commands. 
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INTRODUCTION 


A.  BACKGROUND 

The  concept  of  a  hierarchical  automated  intelligent 
controller,  or  autopilot,  as  a  state-of-the-art  design 
methodology  is  clearly  evident  from  the  proceedings  of  [Ref. 
1] .  As  a  part  of  an  inter-disciplinary  research  program, 
the  Naval  Postgraduate  School  is  investigating  many  facets 
of  automated  control  technologies  for  underwater  vehicles. 
One  of  the  objectives  of  this  program  has  been  to  develop 
operating  "test-bed"  vehicles  and  the  facilities  for 
developing  and  evaluating  real-time  control  systems. 

In  support  of  this  objective,  recent  studies  have  led  to 
the  development  of  a  model-referenced  control  methodology. 
Using  the  equations  of  motion  for  a  vehicle  of  known 
hydrodynamic  characteristics,  computer  simulation  was  used 
to  develop  the  command  generation  logic,  the  design  of  a 
model  following  autopilot  and  evaluate  the  performance  of 
the  selected  AUV  computer  model  [Ref.  2], 

Based  on  this  vehicle's  characteristics,  subsequent 
research  led  to  the  design  and  construction  of  the  first  of 
a  series  of  operational  AUV  models  which  will  be  used  to 
evaluate  evolving  automated  control  technologies  [Ref.  3]. 
This  model  was  used  to  develop  a  technique  for  the 
identification  of  discrete  transfer  function  relationships. 


In-water  tank  tests  were  conducted  for  maneuvers  in  the 
vertical  plane  and  from  these,  data  was  acquired  and 
compared  with  the  computer  model  simulation.  A  system 
transfer  function  relating  dive  plane  commands  to  vehicle 
response  was  then  determined. 

B.  RESEARCH  OBJECTIVES 

The  focus  of  this  research  has  been  to  implement  a 
microcomputer  based  capability  to  support  AUV  data 
acquisition,  vehicle  response  and  transfer  function 
identification,  and  the  development  of  real  time  digital 
control  programming. 

Specific  objectives  included: 

1.  The  acquisition  and  integration  of  available 
hardware  and  software. 

2.  The  documentation  of  specific  implementations  and 
configurations  used  for  the  various  phases  of 
program  development  to  date. 

3 .  The  development  of  a  high-level  language  program 
for  real-time  control  of  the  AUV  test  vehicle 
dive  plane  maneuvering  based  on  the  methodology 
and  results  of  the  research  reported  [Refs.  2,3]. 

This  program  would  affirm  the  on-site  development 
procedure  and  identify  insufficiencies  or 
incompatibilities  which  would  need  to  be 
resolved  to  support  future  research. 

This  thesis  documents  the  accomplishment  of  these 
objectives.  The  integration  of  hardware  and  software  are 
discussed  and  evaluate  in  the  overall  perspective  of  the 
program  development  process.  A  program  was  developed  and 
verified.  This  control  program  was  written  in  Turbo  Pascal 
and  processes  three  analog  sensor  signals  and  issues  a 
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digital  diveplane  command.  The  development  procedure  has 
been  verified,  however  certain  shortcomings  in  multi-channel 
signal  processing  and  software  compatability  are  discussed. 
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II .  EQUIPMENT  DESCRIPTION.  APPLICATION  AND 
PROCEDURAL  DOCUMENTATION 


A.  THE  DESIGN  AND  CONTROL  PROGRAM  DEVELOPMENT  PROCESS: 

AN  OVERVIEW 

The  development  of  real-time  autonomous  control  programs 
is  a  dynamic  and  evolutionary  process.  It  is  the  link 
between  computer  simulations  of  the  systems  and  the 
implementation  of  controllers  to  achieve  desired  performance 
of  these  entities  in  the  real-world.  Autonomous  controllers 
are  exceedingly  complex.  In  the  early  stages  of  controller 
development,  software  implementations  operating  in 
micro-computers  which  interface  the  device  afford  an 
opportunity  for  verification  and  optimization  of  design 
methodology  and  parameters.  Once  designs  have  been 
evaluated,  the  design  logic  is  then  implemented  in  an 
onboard  controller.  In  this  final  implementation,  much  of 
the  control  program  coding  will  have  been  replaced  by 
functionally  equivalent  micro-electronic  devices  which 
peirmit  economies  in  size  and  power  as  well  as  flexibility  of 
application.  The  remaining  control  logic  is  micro-coded 
and  programmed  on  micro  electronic  storage  devices. 

A  principal  objective  of  this  research  was  the 
integration  of  available  software  and  hardware  to  support 
the  various  activities  in  control  program  development  for 
the  AUV.  These  activities  fall  into  three  broad  categories: 
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Data  Acquisition,  Data  Analysis,  and  Design  and 
Implementation  of  real-time  control  programs. 

-  Data  Accmisition  involves  the  assimilation  of  vehicle 
parameters  and  responses  to  known  inputs  under 
controlled  conditions. 

-  Data  Analysis  involves  the  analysis  of  vehicle 
performance  data  for  the  purpose  of  extrapolating 
quantitative  relationships  between  input  commands  and 
vehicle  responses.  These  relationships  are  then 
reflected  as  gain  factors  in  transfer  functions  which 
describe  the  AUV  behavior  or  state. 

-  Design  and  Implementation  of  real-time  control  programs 
entails  the  representation  of  controller  logic  in 
programming  code.  This  software  operates  in  a 
micro-computer  suitably  interfaced  with  the  AUV  to 
permit  the  sampling  of  vehicle  sensor  data  and  to  issue 
appropriate  commands. 

This  chapter  summarizes  the  specifications  of  the 
hardware  and  the  software  utilized  to  support  these  phases 
in  the  research  reported  herein.  The  phases  and  application 
of  these  resources  are  depicted  in  Figure  2.1.  Concluding 
sections  of  this  chapter  document  specific  configurations 
and  commentary  which  supplement  manufacturer's  technical 
reference  materials  with  regard  to  this  research 
application.  Comments  regarding  the  performance  and 
suitability  of  these  reso^urces  are  reported  in  Chapter  IV. 

B.  MICROCOMPUTER  DESCRIPTION 

An  IBM  PC/AT  (compatible)  microcomputer  was  acquired  for 
this  and  future  research.  This  computer  operates  at  6  or  10 
MHz  and  with  0  or  1  wait  states.  An  Intel  80286 
microprocessor  and  an  80287  math  co-processor  were 
installed.  The  Random  Access  Memory  (RAM)  is  expandable 
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Figure  2.1  Phases  of  Program  Development 
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from  its  current  size  of  640  Kbytes.  Installed  floppy  disk 
drives  include  a  1.2M  byte  (high  density)  and  360K  byte 
floppy  disk  drives  are  installed.  The  floppy  disk 
controller  has  the  capability  of  controlling  an  additional 
3.5  inch  disk  drive  as  well.  A  40M  byte  hard  disk  is  also 
installed. 

C.  SIGNAL  PROCESSING:  ANALOG-DIGITAL  INTERFACE 

Interfacing  the  micro-computer  and  the  AUV  is  critical 
to  the  program  development  process.  At  this  interface 
analog  AUV  sensor  signals  are  digitized  for  the  computer 
control  program  through  an  A/D  conversion  process. 

Similarly,  digitized  command  signals  are  converted  to  analog 
equivalent  signals  by  D/A  conversion  processing  prior  to 
transmission  to  the  AUV  analog  servo-control  components. 

The  A/D  signal  processing  was  utilized  exclusively  during 
AUV  test  trials  for  data  acquisition.  Both  modes  of  signal 
processing  were  utilized  in  development  of  the  control 
program.  A  detailed  description  of  the  configurations 
during  these  phases  are  reported  later  in  this  chapter. 

This  section  concludes  with  a  description  of  the  devices 
used  to  achieve  the  analog-digital  signal  processing 
interface  and  a  summary  of  the  technical  specifications 
detailed  in  the  manufacturer's  literature  [Ref.  4]. 

Interfacing  the  AUV  and  the  computer  was  accomplished 
using  two  modern  device  boards.  The  model  DT  2801-A  is  a 
programmable, single  board,  analog  and  digital  I/O  signal 
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processor.  This  board  is  one  of  a  series  designed  for  the 
IBM  Personal  Computers  and  was  installed  into  one  of  the 
backplane  slots  on  the  computer's  mother  board.  Once 
installed,  a  multi-pin  connector,  accessible  at  the  back  of 
the  computer,  facilitates  connecting  the  DT  2801-A  to  an 
external  screw  terminal  panel,  the  DT  707,  by  a  ribbon  cable 
and  connector.  The  DT  707  was  used  to  connect  AUV  sensor 
inputs,  the  command  output,  and  an  external  trigger  signal. 
Specific  configurations  are  discussed  later  in  this  chapter. 

The  following  summarizes  detailed  technical 
specifications  contained  in  the  manufacturer's  product 
literature  [Ref.  4]. 

1 .  DT  2801-A  Digital  and  Analog  Signal  Processor 

This  device  supports  A/D  conversion  processing  on  8 
differential  analog  or  16  single  ended,  unipolar  or  bipolar, 
input  channels  with  12-bit  resolution.  Similarly,  there 
are  2  D/A  conversion  channels  for  processing  output  signals. 
Software  selectable  gains  accommodate  a  range  of  input 
signals.  With  12-bit  resolution  and  programmable  gains  it 
is  possible  to  achieve  a  conversion  accuracy  on  the  order  of 
+/“  0.03%  of  Full  Scale  Reading  (FSR) .  An  onboard  clock  can 
be  used  to  initiate  data  conversion  events  for  periods  of 
2.5  microseconds  to  0.819  seconds  in  1.25  microsecond 
increments.  For  more  precise  initiation  of  data  conversion 
events  or  to  synchronize  with  control  program  timing,  an 
external  trigger  input  is  also  available.  Throughput,  the 
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time  to  execute  one  complete  read  or  write  cycle,  of  27.5 
KHz  can  be  achieved  under  Direct  Memory  Access  (DMA) 
procedures . 

The  onboard  processor  is  programmable  by  any 
language  that  can  access  I/O  registers  of  the  IBM  PC.  Also, 
pre-programmed,  user  callable,  subroutines  are  available  for 
use  with  this  device  under  the  product  name  PCLAB.  [Ref.  5] 
Similarly,  a  complete  Data  Acquisition  software  package, 
DT/NOTEBOOK  is  also  available.  [Ref.  6]  These  products 
were  used  in  this  research  and  are  described  in  later 
sections  of  this  chapter  and  in  chapter  3. 

2 .  DT  707  Screw  Terminal  Panel 

This  unit  along  with  the  ribbon  cable  and  connector 
facilitate  connection  of  I/O  channels  for  analog  to  digital 
signal  process  and  digital  to  digital  signal  processing. 
There  are  also  terminal  connections  for  external  trigger 
signal  sources. 

D,  SOFTWARE  INTERFACING,  ANALYSIS  AND  PROGRAMMING 

1 .  Data  Acquisition 

This  phase  of  program  development  was  greatly 
facilitated  by  the  use  of  a  software  program,  DT/NOTEBOOK. 
[Ref.  6]  The  details  of  its  employment  and  the  system 
configuration  are  reported  in  the  next  section. 

2 .  Data  Analysis  and  AUV  System  Identification 
Assuring  the  capability  to  analyze  vehicle  test  data 

and  identify  discrete  transfer  function  relationships  was  a 
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principal  objective  of  this  research.  This  analysis  was 
accomplished  and  reported  in  [Ref.  3]  using  a  CAD  Program 
called  MATRIXx  [Ref.  7]  This  program  affords  an  extensive 
set  of  design  and  analysis  functions  for  classical  and 
state-space  control.  It  also  provides  a  state-of-the-art 
matrix  analysis  and  graphical  display  capability. 

3 .  Control  Programming  Utilities  and  Language 

PC  LAB  consists  of  a  library  of  low  level  routines 
which  are  callable  as  procedures,  functions  or  subroutines 
in  the  following  high  level  programming  languages:  BASIC, 
FORTRAN,  Pascal,  Turbo  Pascal  and  C.  These  routines  include 
single  and  multiple  channel,  or  block,  A/D  and  D/A 
conversion,  with  buffered  storage  and  DMA  control  options. 
[Ref.  5]  It  should  be  noted  that  multiplexing  of  selected 
inputs  using  multiple  channel,  or  block  read,  procedures  is 
on  the  order  of  microseconds  when  using  the  DT  2801-A  signal 
processing  board.  [Ref.  4]  This  sample  interval  was 
considered  to  adequately  simulate  "instantaneous"  sampling 
of  discrete  vehicle  parameters.  Another  signal  processor, 
the  DT  2818,  is  advertised  to  have  "simultaneous  sample  and 
hold"  and  multiplexes  the  input  channels  on  the  order  of 
nanoseconds.  This  processor  may  have  application  in  future 
program  development. 

The  control  program  reported  in  Chapter  III  was 


written  in  Turbo  Pascal  and  compiled  to  run  under  either  PC 
DOS  or  MS  DOS  operation  systems.  [Ref.  8]  The  facility  of 


the  Turbo  Pascal  program  development  environment,  the 
intrinsic  ability  to  manipulate  text  and  data,  the  screen 
graphics  capabilities  and  recursive  procedure  calls  were 
strong  considerations  in  the  selection  of  this  programming 
language.  Discussion  regarding  use  of  specific  PC  LAB 
routines  and  Turbo  Pascal  programming  are  presented  in 
Chapter  III. 

E.  DOCUMENTATION  AND  CONFIGURATION  FOR  AUV  DATA  ACQUISITION 

This  section  documents  the  configuration  of  hardware  and 
provides  commentary  on  the  application  of  the  DT/NOTEBOOK 
program  as  it  was  used  in  acquiring  data  during  actual  tank 
testing.  Figure  2.2  depicts  the  system  configuration  for 
this  phase  of  the  research. 

The  DT/NOTEBOOK  is  a  menu-driven  data  acquisition 
program  with  options  for  data  analysis.  (These  options  were 
not  used,  however,  in  favor  of  the  more  powerful  CAD  program 
MATRIXx  previously  discussed.)  The  DT/NOTEBOOK  program 
affords  a  high  level  user  interface  with  the  DT  2801-A 
signal  processor  and  was  used  exclusively  for  AUV  data 
acquisition  during  tank  testing.  The  comments  in  this 
section  are  intended  to  supplement  the  excellent  tutorial 
and  user  documentation  provided  with  the  DT/NOTEBOOK  program 
[Ref.  6]  with  comments  specific  to  this  research. 

During  the  AUV  trials  three  channels  of  analog  data  were 
sampled,  digitized  and  stored  for  subsequent  analysis.  The 
three  channels  of  sensor  data  consisted  of  depth,  from  a 
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transducer  output;  speed  from  a  dynamic  head  transducer,  and 
pitchrate  from  a  pitchrate  gyro.  The  configuration  of  the 
DT  2801-A/DT  707  terminal  panel  interface  with  the  AUV  is 
shown  in  Figure  2.3. 

DT/NOTEBOOK  uses  a  hierarchical  menu  concept  much  like 
Lotus  123.  Menu  selections  are  made  by  either  moving  the 
highlighted  input  box  with  the  cursor  keys  until  it 
"captures"  the  desired  option  and  then  pressing  the  <Enter> 
or  by  merely  pressing  the  key  corresponding  to  the  first 
letter  of  the  command  name.  As  successive  options  are  made, 
the  user  moves  deeper  into  the  menu  hierarchy.  At  each 
level,  a  new  menu  of  commands  or  data  input  options  is 
presented.  Pressing  the  <EXC>  key  moves  the  user  back  out 
of  the  menu  one  level  at  a  time. 

Figure  2.4  illustrates  the  Main  Menu.  The  program  is 
contained  on  12  disks.  The  first  of  these  is  a  "Key  Disk" 
which  must  be  inserted  in  Drive  A  during  installation  and 
whenever  the  program  is  first  executed.  Installation 
instructions  are  clear  and  specific  and  are  selected  from 
the  Main  Menu  using  the  INSTALL  command.  During  the 
installation,  two  directories  are  created  on  the  hard  disk: 
Drivers  and  Notebook.  Once  the  installation  has  been 
completed,  the  user  merely  locates  himself  in  the  Notebook 
directory,  inserts  the  Master  Key  in  Drive  A,  and  enters 
"nb"  from  the  keyboard.  The  program  then  displays  the  Main 
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Figure  2.4  DT/NOTEBOOK  Main  Menu 

Menu  of  selections.  The  Master  Key  disk  may  then  be  removed 
and  is  not  needed  again  during  the  current  program  session. 

The  QUIT  command  exits  the  program  and  returns  to  the 
Disk  Operating  System  (DOS).  The  PROGRAM  command  allows  the 
user  to  depart  the  Notebook  program  and  execute  progran.ming 
in  DOS  and  then  return  to  Notebook  without  having  to  "re¬ 
boot"  the  program  with  the  Master  Key  disk.  This  feature 
operates  must  like  a  programmable  interrupt  in  that  the 
"status"  of  Notebook  is  saved  for  the  period  that  the  user 
is  in  DOS  and  is  restored  upon  returning  to  the  Notebook 
program. 

The  CURVE  FIT  and  FFT  commands  are  intrinsic  program 
capabilities  for  curve  fitting  and  fast  fourier  transform 
operations  on  data  files.  The  ANALYSIS  command  permits  the 
user  to  call  an  external  analysis  program  of  the  user's 
choosing.  (Lotus  123  was  used  as  an  example  in  the 
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documentation.)  This  permits  analysis  and  graphical 
representation  from  within  the  Notebook  program.  These 
features  were  not  used  in  this  research.  Acquired  data  were 
analyzed  and  graphed  using  MATRIXx  as  a  stand-alone  program. 

The  remainder  of  this  sub-section  describes  the  data 
acquisition  process  used  extensively  in  this  research  and 
which  was  executed  using  the  SETUP  and  GO  commands  from  the 
Main  Menu.  Figure  2.5  depicts  a  flowchart  of  the  system 
configuration  "setup"  and  data  acquisition  initiation,  or 
"Go,"  process.  It  should  be  noted  that  once  a  suitable 
configuration  has  been  achieved  it  can  be  saved  as  a  setup 
file  and  recalled  for  future  use.  There  were  several  such 
files  saves  in  this  research,  however  the  file  named 
ALTVSETUP  was  used  almost  exclusively  and  its  configuration 
is  reflected  in  the  figures  referenced  in  the  sub-section. 

From  the  Main  Menu,  selecting  the  SETUP  command  results 
in  the  presentation  of  five  configuration  commands  shown  in 
Figure  2.6. 

The  CHANNELS  command  allows  the  user  to  configure  the 
software  to  the  physical  hardware  connections  of  the  DT 
2801-A/DT  707  interface.  The  user  is  first  asked  to  choose 
between  NORMAL  or  HIGH  SPEED  data  acquisition.  The  NORMAL 
command  was  used  throughout  this  research.  The  HIGH  SPEED 
option  was  not  needed  for  the  sampling  required  in  this 
research.  This  mode  places  restrictions  on  data  display. 


CHANNELS  FILES  DISPLAY  VERIFY  SAVE/RECALL 
Initialize  data  acquisition  /  control 


Figure  2,6  DT/NOTEBOOK  SETUP  Ccr.rand  Menu 
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Figure  2.7  DT/NOTEBOOK  NORMAL  Mode  Menu 
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memory  requirements  and  data  buffering  and  file  creation 
which  must  be  considered  if  this  node  is  used. 

Selecting  the  NORMAL  command  results  in  the  presentation 
of  the  NORMAL  Mode  Menu,  Figure  2.7.  A  list  of  "setup 
conditions"  is  presented  down  the  left  side  with  a  column  of 
cells  for  user  entries  to  the  right.  Entries  are  made  by 
using  the  cursor  to  "capture"  the  desired  cell  with  the 
highlighted  input  cell.  Configuration  specifications  are 
input  using  appropriate  keys  which  are  "echoed"  in  the 
Current  Value  cell  in  the  upper  left  hand  corner  of  the  menu 
display.  Pressing  ENTER  or  moving  the  input  cell  with  the 
cursor  key  enters  the  configuration  in  the  program.  The 
program  offers  some  specific  options  for  various  setup 
conditions  which  are  displayed  by  pressing  FI.  It  should  be 
noted  that  the  DT  2801-A  can  sample  up  to  16  input  channels 
(0  ...  15)  and  these  are  specified  by  Interface  Channel 
Number.  The  user  must  recognize  the  distinction  between  the 
"data  channels"  specified  in  the  first  four  lines  of  the 
menu  and  the  interface  channel.  The  data  channels  are  user 
creations  based  upon  the  data  requirements.  The  interface 
channels  are  physical  input  connections  to  the  signal 
processor . 

In  this  research,  data  channel  1  was  always  configured 
as  TIME  and  used  to  record  elapsed  time  for  an  event  from 
the  DT  2801-A  processor  clock.  The  remaining  4  data 
channels  were  specified  to  receive  sensor  input  signals. 


Figures  2.8-2.12  illustrate  thej=e  configuration 
specifications . 

The  next  SETUP  command  is  FILES.  The  option  data  files 
are  configured  to  meet  user  requirements.  Figure  2.13 
illustrates  a  data  file  setup  which  was  used  for  most  of 
this  research.  There  are  two  points  which  need  to  be 
emphasized.  The  first  is  that  after  each  run,  the  user  must 
return  to  this  menu  and  change  the  "Data  File  Name."  If 
this  is  not  done,  NOTEBOOK  will  overwrite  the  new  data  into 
the  same  file.  Secondly,  the  data  field  specification  must 
be  specified  to  meet  the  input  data  file  requirements  of 
MATRIXx  if  the  acquired  data  are  to  be  analyzed  in  this 
program.  A  machine  executable  data  conversion  program 
(convdata.exe)  was  written  to  convert  NOTEBOOK  data  into 
MATRIXx  acceptable  data.  After  gaining  more  familiarity 
with  both  these  programs,  it  was  discovered  that  the  data 
conversion  program  was  not  necessary.  If  properly  specified 
in  the  NOTEBOOK  and  MATRIXx,  data  can  be  used  directly. 
Future  researchers  should  consider  the  experimental  data 
requirements  and  then  consult  the  documentation  of  these 
programs  to  effect  the  proper  configuration. 

One  last  documentation  remark  has  to  do  with  the  file 
naming  convention  used  in  this  research.  Conforming  to  the 
MS-DOW  rules  for  naming  files,  data  files  for  AUV  trials 
were  named  as  the  following  example  illustrates: 
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Figure  2.8  dt/NOTEBOOK  Channel  1  Configuration 
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Figure  2.10  DT/NOTEBOOK  Channel  3  Configuration 
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Figure  2.11  DT/NOTEBOOK  Channel  4  Configuration 
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Figure  2.12  DT/NOTEBOOK  Channel  5  Configuration 
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AV010915.DAT 

AV  :  denotes  AUV  data  acquired  from  NOTEBOOK 
01  :  denotes  the  month  of  the  trial,  i.e.,  January 
09  :  denotes  the  day  of  the  month  of  the  trial 
15  :  denotes  the  particular  trial  for  the  day 
DAT:  was  the  extension  used  for  all  data  files. 

Files  which  were  converted  by  the  data  conversion  program 

for  analysis  with  MATRIXx  were  named  by  the  same  convention 

except  "UV"  was  used  for  the  first  two  characters.  Thus  the 

file  UV010915.DAT  would  indicate  that  this  is  the  data  file 

converted  from  AV010915.DAT  for  use  with  MATRIXx. 

The  next  SETUP  menu  option  is  DISPLAY.  This  command 
specifies  the  setup  for  the  real-time  display  of  data  as  it 
is  being  acquired.  This  feature  is  most  beneficial  in 
evaluating  the  quality  of  the  data  collected.  It  should  be 
noted  that  in  achieving  a  visual  display  the  program  invokes 
a  liberal  "graphical  license"  and  so  the  displays  afford  a 
relative  measure  and  not  an  exact  replication  of  the  data 
acquired.  The  stored  data  file  is  unaltered  by  the  display 
configuration  specification. 

The  DISPLAY  command  presents  the  user  with  two  menus: 
WINDOW  SETUP  and  TRACE  SETUP.  In  these  menus  the  user  can 
specify  the  number,  size  and  type  of  the  display  windows  and 
the  data  trace  characteristics.  There  is  considerable 
flexibility  and  the  program  documentation  should  be 
consulted  to  exploit  this  feature.  Figures  2.14  and  2 . " 
illustrate  configurations  used  in  this  research  to  display 
three  windows  and  their  respective  traces. 
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Figure  2.14  DT/NOTEBOOK  Window  Setup  Configuration 
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The  next  SETUP  is  VERIFY.  Executing  this  cominand 
displays  a  screen  which  reflects  the  configuration  which  a 
user  has  specified.  This  provides  a  good  check  of  the 
system  setup. 

The  last  SETUP  command  is  SAVE/RECALL.  As  the  title 
suggests  this  command  allows  the  user  to  save  a  particular 
configuration  setup  as  a  specific  file  or  to  recall  such  a 
file  for  reuse. 

Once  a  system  configuration  has  been  specified  and  the 
AUV  is  connected  to  the  DT  2801-A/DT  707  interface,  actual 
data  acquisition  is  initiated  by  selecting  the  GO  command 
from  the  Main  Menu.  In  its  default  configuration,  the 
program  will  commence  data  acquisition  as  soon  as  GO  is 
selected.  However,  a  useful  feature  is  the  "Keystroke 
Before  Run"  which  is  selectable  in  the  INSTALL,  OPTIONS 
commands.  This  delays  the  beginning  of  data  acquisition 
after  GO  is  selected  until  "any  other  key"  is  depressed. 

This  feature  was  used  throughout  this  research  as  it 
permitted  more  precise  control  over  the  data  acquisition 
events . 

F.  DOCUMENTATION  AND  CONFIGURATION  FOR  AUV  CONTROL 

Figure  2.16  depicts  the  system  configuration  for  control 
of  the  AUV  under  high-level  language  control  programming. 
Figure  2.17  shows  a  schematic  of  the  DT  707  terminal 
connections.  Owing  to  the  non-availability  of  the  test  tank 
and  suitable  radio  transmitter  interface  module  to  transmit 
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Figure  2.17  Terminal  Board  Configuration  for 
Real-time  Control 


the  generated  dive  plane  command  to  the  AUV,  real-time 
control  was  not  accomplished  in  this  research.  Figure  2.18 
shows  the  system  configuration  used  to  simulate  real-time 
control  configuration  in  the  development  and  verification  of 
the  control  program.  Details  of  the  program  development  and 
verification  are  reported  in  Chapter  III  of  this  thesis. 
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Fiqure  2.  la  System  Conf  i‘F*rat  ion 


III. 


PROGRAMMING  VERIFICATION 


This  chapter  reports  on  the  final  objective  of  this 
thesis:  verification  of  I/O  processing  of  analog  and 

digital  signals  under  higher-level  program  control.  The 
following  sections  discuss  the  design,  implementation, 
verification  and  documentation  of  this  program.  A  complete 
and  documented  listing  of  the  main  program  is  contained  the 
Appendix . 

A.  PROGRAM  PERSPECTIVE  AND  DESIGN 

The  introduction  of  [Ref.  2]  presents  a  concise 
description  and  illustration  relating  this  concept  to  this 
and  other  current  research  at  the  Naval  Postgraduate  School. 

The  theory  of  classical  (closed  loop)  controllers  as  well 
as  modern  state-space  design  of  Digital  Autopilots  are 
further  discussed  in  [Refs.  10,11].  In  its  final 
implementation,  a  digital  autopilot  will  control  all  six 
degrees  of  freedom  of  the  AUV  in  the  execution  of  a  variety 
of  missions  and  in  a  diversity  of  operating  environments. 

The  architecture  of  the  autopilot  will  reflect  extensive 
functional  modularity.  Under  the  supervisory  control  of  an 
"AUV  Operating  System,"  missions  will  be  executed  as  a 
sequence  of  tasks  compiled  and  ordered  by  the  onboard 
planning  logic  and  knowledge  database.  Similarly, 
completion  of  these  tasks  will  reflect  the  compilation  and 
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execution  of  functional  capabilities  in  sequence  or  in 
parallel  under  the  control  of  a  lower-level  operating 
system.  These  functional  capabilities  may  well  be 
implemented  as  multi-processors  each  reflecting  a 
hierarchical  organization  specific  to  their  required 
functional  responsibility. 

Timing  will  be  a  critical  to  the  successful  assimilation 
of  functional  modules  and  the  accomplishment  of  tasks  and 
missions.  The  top  level  "AUV  Operating  System"  will  provide 
a  master  synchronizing  timing  signal  based  optimal 
considerations  of  the  cycle-time  requirements  of  the 
subordinate  processors.  Cycle-time  is  the  time  required  to 
receive,  process  and  transmit  information.  Cycle-time  will 
be  most  affected  by  the  processing  interval.  Modern  digital 
controller  design  must  therefore  concern  itself  with 
optimizing  response  and  processing  time  requirements. 

A  Model-Referenced  Autopilot  design  was  evaluated  and 
found  to  be  most  suited  to  control  of  the  rapid  maneuvering 
and  changing  environmental  and  "plant"  parameters  which  will 
be  encountered  in  an  AUV  [Ref.  2]  In  contrast  to  the 
classical  accomplishment  of  vehicle  maneuvers  through  the 
independent  action  of  rudder  and  diveplane  for  course  and 
depth  control,  a  Model  Referenced  design  will  be  a 
multivariable  control  structure.  It  will  require  the 
parallel  processing  of  vehicle  sensory  data  to  determine  a 
vehicle  state,  comparison  with  a  model  reference  state  and 
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the  determination  of  an  appropriate  command.  As 
verification  of  the  on-site  program  development  capability, 
this  research  sought  to  investigate  the  cycle  time 
requirements  of  a  high-level  language  control  program  which 
emulated  the  modular  organization  of  a  model  referenced 
controller  and  exercised  the  signal  processing  functions  of 
the  DT  2801-A  hardware  and  software. 

B.  PROGRAM  IMPLEMENTATION 

This  program  represents  a  functional  module  at  the 
lowest  level  of  the  digital  autopilot  hierarchy:  the 
analog-digital  interface  between  the  AUV  servo-controllers 
and  the  onboard  digital  processing  capability.  As  discussed 
in  Chapter  II,  the  verification  process  was  simulated  using 
signal  generators  (Figure  2.18).  Three  analog  sensory 
signals,  simulated  by  inputs  from  signal  generators  are 
sampled.  These  signals,  represent  AUV  transducer  outputs 
for  depth,  speed  and  pitchrate.  The  amplitude  of  these 
signals  are  representative  of  actual  AUV  signals  measured 
during  tank  testing.  Respective  ranges  of  amplitudes  of 
these  signals  are  +/-  10,  +/-  5,  and  +/-  1.25  volts.  The 
sampled  analog  signals  are  then  processed  by  the  program: 
the  speed  and  pitchrate  signals  are  processed  for  display 
only;  the  depth  signal  is  processed  by  the  control  modules 
which  generate  an  outgoing  command  (voltage)  to  the 
diveplane  actuator  channel.  An  external  trigger  simulates 
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the  master  timing  signal  as  it  might  be  implemented  in  an 
actual  processor  onboard  an  AUV. 

The  program  implements  a  closed  loop  control  process 
within  a  user  interface  shell.  As  depicted  in  the  program 
pseudo-flow  chart  (Figure  3.1),  the  user  enters  a  desired 
AUV  target  depth  and  then  turns  control  of  the  AUV  over  to 
the  control  loop.  It  was  intended  that  the  user  have  the 
facility  to  interrupt  the  control  sequence  by  pressing  key 
<F1>  to  enter  a  new  target  depth,  <F2>  to  halt  the 
controller  and  reset  the  program,  or  <ESC>  to  exit  the 
program.  It  was  discovered  in  the  final  assembly  of  the 
program  modules,  however,  that  the  PCLAB  signal  processor 
routines  masked  the  keyboard  interrupt  device  thus  denying 
access  to  programmable  interrupts  for  program  control. 
Although  this  problem  did  limit  the  interactive  features  of 
the  program,  it  did  not  interfere  with  the  active  control  or 
validation  of  the  development  system.  This  problem  is 
discussed  in  Chapter  IV. 

This  program  utilizes  routines  which  are  provided  with 
the  PCLAB  real-time  software.  In  many  of  the  compiled 
language  implementations  which  includes  Turbo  Pascal, these 
routines  are  programmed  as  functions  which  return  integer 
error  codes  as  well  as  passing  analog  or  digital  data 
values.  Programming  these  routines  is  accomplished  by 
declaring  an  integer  variable  and  then  calling  the  desired 
routine.  For  example,  STATUS  is  the  declared  integer 
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MAIN 


MEN  L’ 


Q  ...  QUIT  return  to  DOS 
R  ...  RUN  the  Control  Program 


STATUS  and  COIDUVND 


GET  TARGET  DEPTH  - - 

_ 1 

CLOSED  LOOP  CONTROL 


Nhile  no  keypressed 

'get  digital  sensory  data 

.  get  depth,  speed  and  pitchrate 
.  convert  to  analog  equivalent  value 


ER.ROR  VOLl^ 


compute  error  voltage  between 
actual  depth  and  model  reference 
target  depth 


GENERATE  DIVE  PL.ANE  COMMAND 


IF 

KEY 

FI 

.  .  .  GET  NEW  TARGET  DEPTH 

IF 

KEY 

F2 

. . .  RESET  PROGRAM  FOR  NEXT 

RLTI 

IF 

KEY 

ESC 

. . .  EXIT  PROGRAM  AND  RETURN 

TO  MENU 

I 


Figure  3.1  Closed  Loop  Control  Program  Flow  Chart 
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variable  used  in  the  program  code.  Calling  a  single  value 
Analog  to  Digital  conversion  is  accomplished  with  the 
following  statement: 

status=  adcvalue  (<channel  ' , <gain> , <user  declared 

data  variable  >) 

<  >  denote  required  declarations 

Literally  interpreted,  this  statement  says  that  "Status  gets 
the  integer  error  code  of  the  function  adcvalue."  Error 
codes  are  automatically  processed  by  an  error  processor  and 
if  an  error  is  encountered  in  the  data  conversion,  an  error 
message  is  printed  to  the  display  screen.  The  data  values 
are  passed  to  the  program  as  value  parameters  and  may  be 
treated  as  any  other  data  parameter  in  program  coding  and 
manipulation.  PCLAB  reportedly  supports  single  or  block 
data  conversion  routines.  However  several  attempts  to  use 
the  block  routines  to  convert  data  from  selected  sensor 
channels  were  not  successful.  This  problem  is  discussed  in 
Chapter  IV. 

The  following  sub-sections  supplement  the  program 
commentary  found  in  program  listing  (Appendix) ,  and  describe 
the  salient  modules  which  implement  the  Closed  Loop  Control 
routine.  The  titles  of  the  subsections  correspond  to  the 
title  of  the  program  modules  as  listed  in  the  Appendix. 
Appendix  D  [Ref.  5]  contains  the  algorithms  for  analog  and 
digital  conversions.  These  have  been  used  in  the  following 
procedures  where  such  data  manipulation  is  required. 
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1 .  Initialize  Zero  Digital  Signal  Out 

This  routine  must  executed  at  the  beginning  of  the 
program  so  as  to  send  a  zero  voltage  digital  signal  out. 

The  DT  2801-A  defaults  to  sending  out  a  minimum  full  scale 
reading  out  as  soon  as  it  is  powered  up.  It  is  therefore 
important  to  "zero"  the  output  signal  before  attaching  the 
test  vehicle.  This  routine  "zeroes"  the  signals  of  both 
analog  to  digital  output  channels. 

2 .  Convertspeed .  Convertdepth  and  Convertpitchrate 

These  are  three  functions  which  convert  digital-to- 

analog  data  values  to  .AUV  parameters.  The  algorithms  for 
these  conversions  are  based  on  tank  tests  conducted  on  the 
AUV  and  are  reported  in  [Ref.  3] 

3 .  GetTaraet Depth 

This  procedure  solicits  the  AUV  operating  depth  from 
the  user  (an  integer  input)  and  converts  it  to  an  analog 
voltage  based  upon  the  depth  to  voltage  relationship  derived 
during  testing.  This  ecjuivalent  analog  voltage  is  passed  to 
the  control  program  for  control  processing. 

4 .  GetDiaitalSensorvData 

This  procedure  samples  three  channels  of  sensory 
input  and  converts  them  to  AUV  analog  equivalent  values 
using  the  previously  mentioned  functions.  These  values  are 
then  passed  to  the  control  program  as  representing  the  state 
of  the  AUV.  Several  designs  were  envisioned  using  single 
and  block  data  transfers  so  as  to  achieve  a  suitable 
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throughput  and  synchronization  of  this  event.  ADConTrigger 
is  a  single  value  conversion  routine  which  executes  on  the 
high  to  low  transition  of  an  external  trigger.  As  soon  as 
this  conversion  is  completed,  two  ADCValue  commands  convert 
data  for  the  remaining  two  sensory  channels.  Timing  studies 
for  a  single  value  conversion  affirmed  a  throughput  on  the 
average  of  0.6  msec.  The  throughput  for  the  one  triggered 
and  two  single  value  conversions  averaged  2.5  msec. 

5 .  Errorvolts 

This  procedure  computes  a  difference  or  error 
voltage  between  the  analog  voltages  for  target  and  actual 
depths.  A  "voltage  filter"  has  been  implemented  to  permit  a 
tolerable  difference  range  above  and  below  the  target  depth. 
This  precludes  trying  to  achieve  an  absolute  zero  difference 
which  is  an  not  a  practicable  design  in  manipulating  the 
digital  to  analog  conversions.  It  also  allows  the  AUV  a 
defined  range  in  which  no  changes  in  plant  operating 
parameters  are  required  to  maintain  a  desired  depth.  The 
computed  error  voltage  is  then  passed  to  the  control  program 
for  processing  by  the  GenerateDiveCommand  module. 

6 .  GenerateDiveCommand 

This  procedure  simply  converts  the  computed  error  or 
difference  voltage  to  an  analog  equivalent  and  sends  this 
signal  out  on  the  specified  analog  to  digital  channel. 
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C.  PROGRAM  VERIFICATION 


The  verification  configuration  and  objectives  have  been 
previously  stated.  The  evaluation  of  the  cycle  time 
requirement  is  based  on  the  minimum  required  AUV  sampling 
time  in  order  to  maintain  real-time  control.  A  critical 
real-time  control  interval  of  50  mSec  or  a  sampling  rate  of 
20  Hz  was  established  as  a  standard  based  upon  evaluation  of 
data  collected  and  reported  in  [Ref.  3]. 

Notwithstanding  the  problems  encountered  with 
programmable  interrupt  control  and  block  data  conversions 
using  the  PCLAB  routines,  high-level  program  control  of  the 
analog  and  digital  I/O  signal  processing  was  achieved. 

Cycle  times  were  measured  at  various  sampling  rates  as 
simulated  by  the  frequency  of  the  external  trigger  signal. 
Figures  3. 2-3. 4  show  the  results  of  these  timing  studies.  A 
cycle  time  on  the  order  of  5  msec  was  recorded.  This  cycle 
time  is  well  within  the  required  limit  and  affords  an  ample 
margin  for  more  extensive  sensor  sampling,  control 
processing  and  multiple  command  generation. 

D.  PROGRAM  DOCUMENTATION 

The  documentation  of  the  program  listing  and  the 
previous  sections  in  this  chapter  have  described  the  logic 
and  function  of  the  program.  This  section  documents  the 
filenames  and  other  information  which  may  assist  follow-on 
research. 
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The  control  program  is  named  AUVPILOT  with  extensions  ct 
.PAS  and  .COM  for  the  Turbo  Pascal  and  executable  machine 
codes,  respectively.  The  included  files  declared  at  the 
beginning  of  the  program  listing  (Appendix)  all  have  a  file 
extension  .AUV.  These  programs  provide  utility  support  for 
screen  displays  and  program  timing.  Some  of  these  programs 
are  adaptations  of  routines  discussed  in  [Ref.  9],  while 
others  were  created  to  meet  specific  needs  of  the  main 
program- 

The  Turbo  Pascal  v  3.0  programming  environment  and 
language  features  are  thoroughly  explained  in  [Ref.  8].  No 
additional  explanation  is  considered  necessary.  One  major 
consideration  in  the  utility  of  this  programming  language  is 
that  in  the  recently  released  4.0  version,  the  code  size 
limitation  of  64K  bytes  has  been  eliminated  thus  making  it 
suitable  for  very  large  program  applications.  The 
compatibility  problems  with  PCLAB  routines  still  remain  to 
be  resolved,  however.  PCLAB  does  not  as  yet  support  this 
latest  version. 
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IV.  SUMMARY.  CONCLUSIONS.  AND  RECOMMENDATIONS 


A.  SUMMARY 

The  thesis  has  described  the  hardware  and  software 
details  of  an  IBM-PC  based  controller  as  a  shell  for  further 
development.  The  software  has  been  used  for  digital  data 
acquisition  and  cycle  time  studies  have  been  performed  for 
throughput  of  control  signals  operating  fr  n  an  external 
trigger  source. 

B.  CONCLUSIONS 

The  work  of  this  thesis  demonstrated  the  ability  of  an 
IBM-PC  based  microcomputer,  coupled  with  an  advanced  D/A  and 
A/D  conversion  board  to  provide  both  data  acquisition  and 
control  functions  that  will  be  required  in  any 
implementation  of  an  intelligent  controller  for  Automated 
Underwater  Vehicles. 

Cycle  time  for  sensing  three  signal  channel  input.^, 
computation  of  tracking  error,  and  sending  of  updated 
control  signals  is  5  msec.  With  a  sample  time  of  0.05 
seconds,  45  msecs  are  available  for  storing  data,  updating 
vehicle  parameter  estimates,  and  interfacing  with  higher 
level  supervisory  control  programs.  The  trigger  for  sample 
initiations,  at  present,  is  timed  by  an  external  clock. 

The  structure  implemented  herein,  is  now  capable  of 
being  expanded  to  incorporate  the  control  signal 
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formulations  necessary  to  achieve  full  implementation  of  m 
automated  digital  autopilot. 


C.  RECOMMENDATIONS 

The  problems  with  programmable  interrupt  control  and 
multiple,  or  block,  data  conversions  discussed  in  Chapter 
III  present  several  issues  which  need  to  be  resolved. 

First,  if  Turbo  Pascal  is  to  be  used  in  future  research, 
these  problems  will  have  to  be  resolved  through  direct 
correspondence  and  consultation  with  the  development  firm. 
Furthermore,  the  near-term  availability  of  PCLAB  routines 
for  Turbo  Pascal  v  4.0  should  be  assured  so  as  to  support 
development  of  large  control  programs.  At  this  juncture  in 
the  research,  it  is  perhaps  best  to  evaluate  other  compiled 
high-level  languages  with  respect  to  the  stated  benefits  of 
Turbo  Pascal  and  the  programming  requirements  of  more 
complex  Digital  Autopilot  implementations.  Program 
interfacing  with  other,  more  "intelligent"  digital  control 
modules  should  also  be  considered  so  as  to  assure  future 
integration  of  program  modules  under  development  by  the 
various  departments  at  the  Naval  Postgraduate  School. 
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APPENDIX 


'r~ 


LISTING  OF  CONTROL  PROGRAM  CODE 

proi;raa  AuvAutoPllot  (  Input,  output  ); 


(  TITLE  :  Autonoaous  Underwater  Vehicle  Auto  Pilot  Prograa. 

AUTHOR  :  COR  Stephen  W.  Oelaplane.  USN 

APPLICATION  :  Partial  (ultlllaent  o(  Thesis  Research  for  the  deitree 
Masters  of  Science  in  Mechanical  En;ineerm<. 

DATE  :  18  March  1988 


Project  Description  :  This  prograa  lapteaents  digital  control  of  the  NPS 
autonoaous  underwater  vehicle  <AUV)  in  the  vertical  or  dive  plane.it  saaples 
vehicle  sensor  Input  froa  three  channels  :  depth,  speed,  pltchrate.  The 
depth  signal  Is  than  passed  to  a  OepthError  aodule  which  coapares  the  actual 
sensor  depth  with  a  aodel  reference  depth  siaulated  by  a  depthgain.  A  depth 
error  voltage  Is  then  generated  and  passed  to  a  GenerateOlvePlaneCoaaand 
aodule  which  processes  the  error  signal  and  sends  out  an  appropriate  coaaand 
to  the  dlveplane  actuators-  The  gams  In  the  algorlthas  reflect  the  discrete 
transfer  function  gams  for  dlveplane  coaaand  response  derived  froa  vehicle 
Identification  analysis.  ) 


I  GLOBAL  DECLARATIONS 


cons  t 

(  -  Screen  declarations 

xl  =  5: 

yl  =2: 

x2  =  75; 

y2  =2  4; 


type 

strlO  =  string  [101; 
str60  =  string  [601; 

var 

hr,hr2.aln,ain2, 

sec,sec2,hun,bun2  ;  byte; 

seconds  ;  real: 

option,  controlaode, 
reply, reply2  :  char; 


. .  ) 

<  Upper  left  corner  ;  left  edge  ) 

I  Upper  left  corner  :  upper  edge  ) 

(  Lower  right  corner  ;  right  edge  ) 

(  Lower  right  corner  ;  bottoa  edge  ) 


( 


INCLUDED  FILES  Declarations 


) 


(tl  pcldefs.tp  }  (PC  LAB  Trubo  Pascal  routines.  ) 

(91  pclerrs.pas  )  (PC  LAB  error  code  aessages  file.  1 

(fllnidac.auv  ) 

(  This  procedure  Initializes  the  DT  2801 -A  TO  ZERO  VOLTS  AND  MUST  BE 
EXECUTED  BEFORE  THE  AUV  (S  HOOKED  TO  THE  COMPUTER.  It  Is  called  as 
procedure  InltlallzeZeroDlgltalSIgnalOu t.  ) 

(figettlae.auv  1  (  No  arguaents;  returns  hr,  aln,  sec,  bun  :  byte  I 


(fishotadf f.au V  > 

(  Input  the  output  of  TIaeDIff.auv  and  this  procedure  displays  the  tlae 
difference  between  the  two  aost  current  GetTlae.auv  results. 
SbowTIaeDitferene  (  x:lnteger)  .  ) 
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( 1 1 1  laedl  t  (.au  V  ) 

(  Input;  br,br2,Bln,aln2,sec,3ec2,hun,bun2  (roa  t«o  calls 
o{  CetTlae.auv  and  this  returns  thft  difference  In 

seconds  as  a  REAL  variable.  ) 

( Sldravbox2.au  V  1 

(  Input  xl,yl,x2,y2  :  Integer  to  specify  tbe  corner  Halts  of  the  box. 

This  procedure  clears  screen  and  draws  a  rectangular  box  of  specified 
dlaenslon  using  ASCII  double  line  characters.  ) 

(tIclrbox2.auv ) 

(  Input  xl,yl,x2,y2  :  Integer  to  specify  tbe  corner  Halts  of  the  box. 

This  procedure  uses  a  FAST  aeans  of  clearing  a  box  of  specified  dlaenslon. 


Tbe  box  dlaenslon  should  be  delcared  as  constants.  ) 

( tiboxpr  In  t  .au  V  ) 

(  Input  the  prlntrow,  leftboxedge,  rlghtboxedge  ;  Integer  and  printstring  ; 
str60.  This  procedure  centerprints  the  string  In  the  box  at  the  prlntrow 
specified  without  overwriting  the  box  border.  ) 

{ SIsbow  f as  t .au V  t 

(  Input  aessage  :  str60,  coluan.row  :  Integer.  To  specify  the  x.y  position 

on  the  screen  for  a  FAST  aessage  print.  ) 

(tlkeyhtt.auvl 

(  This  Is  a  boolean  function  which  returns  true  or  false  If  key  1$  pressed; 

It  also  returns  keycode  replies  VaR  reply,  reply2  :  char  ) 

(lltabxy.auvl 

{  Input  tabcol.tabrow  -.  integer;  like  gotoxy  ) 

(tiboxpause.auv ) 

{  Input  xpause.ypause  :  Integer  to  specify  where  "Press  any  key  to  continue" 

aessage  is  to  be  printed.  ) 

(SIgetkey.auv  ) 

(  Input  as  a  string  of  chars,  the  set  of  acceptable  replies;  le  'YyNn'.  This 
procedure  waits  until  one  of  the  acceptable  replies  has  been  entered.  1 

Iflutlls.auv  > 

'  Included  are  soae  hou sekeepptng  and  debugging  routines.  ) 


(tIconvadv.au V  ) 

{  Includes  functions  to  convert  depth. speed  and  pltchrate  to  vehicle  values.  ) 
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{  proGRAHS  procedures 

{  .ms.mo.xm.Exo  vjsER  INTERFACE  MODULES 


procedure  UalnMenu  (  var  rer  y  :  cbar  ); 

(  This  procedure  presents  the  AUV  screen  and  solicits  an  option  to  Run 

the  AUV  froa  the  StatusAndCoaaand  procedure  or  to  Quit.  ) 

begin 

repeat 

clrscr: 

drawbox2(xi,y  l,x2,y  2); 

boxprlnt(yl-3.xl.x2,'N  AVAL  POSTGRADUATE  SCHOO  L); 
boxprlnt(yl*5.xl.x2,'D  EPARTMENT  OF’l; 

bozprintly  l>6,xl,x2,'li  ECHANICAL  ENGINEERIN  G); 

boxprlnttyl  *-8, X1.X2, ‘AUTONOMOUS  UNDERWATER  VEHICLE’); 

boxprtnt(yl>10,xl,x2,'DIGITAL  AUTOPILOT  CONTROL  PROGRAM): 


boxprlntly  1  »i2,xl,x2, '•**********»*»*••**••»•*•*******•»**•*'); 
boxprlntty  1 1  S,xl,x2,'Do  You  want  to  RUN  this  prograa  ..'); 


boxprln t(y  1  <- 1 6,xl,x2,'or  Do  You  want  to  QUIT  and  return  to  DOS  '’'): 
boxprtnt(yl»20,xl,x2,'>»>  ENTER  Q  OR  R  <<<<); 
getkey  CQqRr', reply, reply 2); 
until  (  reply  in  ['Q','q','R','r']  )  and  (reply2  =  chrtO)); 
end; 

procedure  StatusAndCoaaand  (  var  aode  ;  char  ); 

(  This  procedure  begins  the  control  prograa  screen.  ) 

var 

aode2  :  cbar; 

procedure  Statu sAndCoaaandScreen: 

(  This  Is  the  status  and  control  screen  and  solicits  a  user  Input  of  FI  to 
RUN  the  prograa  or  Q  to  Quit  and  exit  to  the  aaln  aenu.  ) 

begin  {  -  Statu SAndCoaaandScreen  -  ) 

clrbox2  (xl,y I,x2,y2): 

boxprlnt<yl*l,xl,x2,’AUV  STATUS  /  COMMAND  AND  CONTROL  SCREEN'); 
boxprln t(yl  ♦■2,xl,x2,'= ’  =  =  =  *  =  =  =  =  *  =  =  =  =  =  =  ®  =  =  =  =  =  =  =  «»•  =  =  =  •  =  =  =  =  *  =  «  =  =  =  =  =  =  =  =  =  ='); 
boxprlnt(yl«7,xl,x2, 'CHOOSE  YOUR  DESIRED  CONTROL  MODE 
boxprlnt(yl»9,xl,x2, 'ENTER  KEY  «  FI  »  TO  START  AUV  CONTROL’): 
boxprlnt(yl*ll,xl,x2,'ENTER  <<  Q  »  TO  QUIT  AND  RETURN  TO  MAIN  MENU’): 
boxprlntly  11-16, XI, x2,’PRESS  EITHER  FI  OR  Q’>: 

end;  {  -  StatusAndCoaaandScreen  -  ) 
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( 


CLOSED  LOOP  CONTROL  ROUTINES 


I 

I 


I 

< 


1 


I 

* 

I 


procedure  ClosedLoopControi; 

(  This  Bodule  coaprlses  tbe  closed  loop  control  scheae.  ) 

cons  t 

■axdepth 
■tndepth 
upd  atelncreaent 

type 

actlvecontrolaoda  =  (  run,  reset,  exit  ): 
allowabledepthrange  =  ■Indeptb.-aaxdeptli  ; 

auvattltude  =  (  cllab,  aalntaln,  diving  ); 

dlgltallntegerarray  =  array  (1..3]  of  Integer; 

var 

auvdepth,  auvdepthvo It s,auv speed, 
auvspeedvolts,  auvpttchrate,  auvpitchratevolt s, 
deptherror volts,  targe tdeptbvolts 
adv 

J, status 

aodereply,aodereply2 
actlveaode 
targetdepth, 
updatecounter 
depthrange 
attitude 

(unction  convertdeptb  (  analogvalue  ;  real  )  :  real; 

(  Tbis  (unction  converts  a  depth  analog  volts  value  to  an  AUV  status 


paraaeter.  This  (unction  is  derived  (roa  experlaental  observation.  ) 

begin  { - function  convertdeptb  -  } 

convertdeptb  ;=  (  analogvalue  -  1.6270  )  /  0.2570  : 

end;  ( - (unction  convertdeptb  -  ) 

(unction  convertspeed  (  analogvalue  ;  real  )  ;  real; 


{  This  (unction  converts  a  speed  analog  volts  value  to  an  AUV  status 

paraaeter.  This  (unction  is  derived  (roa  experlaental  observation  ) 

(  Speed  o(  the  AUV  was  determined  by  band-tlalng  the  vehicle's  passage  In  the 
test  tank,  over  a  distance  of  S(t  (  2  window  panels  )  while  bolding  the  speed 
voltage  constant.  Various  trials  were  performed  at  different  Input  voltages 
to  establish  a  voltage  to  speed  relationship.  In  theory  this  Is  a  quadratic 
relationship.  The  data  alluded  to  a  quadratic  relatlonslp,  but  because  the 
voltage  saturated  the  range  quickly.  It  was  difficult  extract  a  precise 
(unction.  Accordingly  this  (unction  asserts  average  speed  values  for  various 
ranges  of  voltages  based  on  the  timing  trials.  This  conversion  will 
uiidoubtedly  become  better  defined  as  more  vehicle  data  Is  taken  and  analyzed.) 

begin  ( - (unction  convertspeed  -  ) 


real; 

:  dlgltallntegerarray; 
;  Integer; 

:  char; 

:  activecontrolmode; 

;  Integer; 

;  allowabledepthrange; 
;  auvattltude; 


-  33; 
=  0; 

=  10; 
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U  (  analogvalue  <=  2.32  )  then 

convert  speed  0.0 

else  1(  (  anato$value  >  2.3200  )  and  (  analogvalue  <'  2.S200  >  then 
convertspeed  1.2S7S 

else  If  (  analogvalue  >  2.S200  >  and  (  analogvalue  <=  2. 5440  )  then 
convertspeed  1.3913 

else  '  (  analogvalue  >  2.5440  )  and  <  analogvalue  <-  2.6200  )  then 
convertspeed  ;  ’  1.8233 

else  If  (  analogvalue  >  2.6200  )  then 
convertspeed  :=  1.8233 

end;  ( - function  convertspeed  -  ) 

function  conver t pi t chr a t e  (  analogvalue  ;  real  )  :  real: 

{  This  function  converts  a  pltchrate  analog  volts  value  to  an  AUV  status 


paraseter.  This  function  Is  derived  froa  experlaental  observation.  ) 

const 

convertconstant  =  0.125;  (  conversion  constant  ) 

begin  t  -  function  convertpltchrate  -  ) 

convertpltchrate  analogvalue  '  convertconstant; 

end;  (  function  convertpltchrate  -  1 

procedure  ClosedLoopControlScreen; 


1  This  procedure  displays  the  Closed  Loop  Control  Screen.  It  Is  displayed 
throughtout  the  AUV  pilottlng  run.  It  Is  updated  «lth  status  and  control 
paraaeters  by  control  routines  as  they  execute  In  the  prograa  sequence.  ) 

begin  (  - ActlveCont rolScreen  -  ) 

clrbox2  (xl.y I,x2,y2); 

boxprlntfyl  *l.xl,x2.'A  UV  STATUS  /  CONTROL  SCREE  V); 
bo xprintty  I  *2, xl, x2. '  =  =  =  =  =  »  =  =  =  =  =  =  *  =  =  =  =  =  =  =  =  =  *  =  =  =  =  =  =  =  =  =  =  =  =  =  »  =  =  =  =  »  =  *  =  =  =1; 
boxprint(yl*4,xl,x2,  STATUS  OF  A  U  V  OPERATING  PARAMETERS  : 

•  rlteln  (tabxy  (xl  *5,y  1 ‘6),'AUV  DEPTH  [  In  )  : 

•  rlteln  (tabxy  (xl  ♦  5,y  1  *7),'AUV  SPEED  [  ft/sec  ] 

wrlteln  (tabxy  (xl  *  5,y  I  *  Sl.’AUV  PITCHRATE  [  Deg  .  sec  J  . 
boxprlnt(yl*10,xl,x2,'A  U  V  CONTROL  STATUS'); 

write  (tabxy  (xl*5,yl*12),’CURRENT  TARGET  DEPTH  ; 

write  (tabxy  (xl*5,y I ♦  1 3),'CURRENT  AUV  OPERATING  MANEUVER  ;  '); 
write  (tabxy  (xl  *-5,y  i  ♦14),'CURRENT  AUV  OPERATING  MODE  ;  '); 

boxprlnt(yl*lT,xt,s2,'THIS  WILL  BE  THE  DISPLAY  DURING  AUV  CONTROL); 
boxprlnt(yl*18,xl,x2, 'STATUS  WILL  BE  UPDATED  EVERY  SECOND.  ); 
boxprlnt<yl*19,xl,x2.'NEXT  :  ENTER  AUV  OPERATING  DEPTH  '); 

boxpausa(xl<'lS,yl»2i); 

end;  (  - ActIveControlScreen  -  ) 
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procedure  GetTarse tOepth  (var  tjtdepth  :  Inteser  ; 

var  tjtdepthvoUs  :  real  ): 

(  This  procedure  solicits  the  target  AUV  operating  depth  and  converts  It  to 
an  AUV  equivalent  tgtdepth  analog  voltage  and  passes  both  o(  these 
paraaeters.  ) 

begin  I  -  GetTargetDepth  -  ) 

clrbox2  (xl,y  l,x2,y  21; 

boxprintlyl  *-10, xl.x2.  ENTER  THE  AUV  TARGET  OPERATING  DEPTH  ); 
boxprint(yl»ll,xl,x2,'»  NOTE  ;  THE  DEPTH  SHOULD  BE  IN  WHOLE  INCHES  <<); 
repeat 
begin 

boxprlnt  (y  1  *  1  3.xl,x2. ENTER  THE  TARGET  OPERATING  DEPTH  ); 
gotoxy  (xl<-33.yt‘15); 
read  (  tgtdepth  ); 

end; 

until  (  tgtdepth  in  CO. .451); 

t  This  next  statement  converts  the  Integer  user  Input  target  depth  to  an 
analog  control  voltage  base  on  tank  calibration  test  data  acquired.  ) 

tgtdepthvolts  :=  1.627  0.257  •  tgtdepth  ; 

end:  (  -  GetTargetDepth  -  ) 

procedure  ‘tunModeScreen; 

(  This  procedure  displays  the  Closed  Loop  Control  Screen  In  the  RUN  MODE. 

begin  {  - RunHodeScreen  -  ) 

clrbox2  (xl,y l.xZ.y 2); 

boxprlntCyl*l.xl.x2.'A  UV  STATUS/CONTROL  SCREEN) 
boxprlntcy  1  *2, xl,x2, ■  =  =  =  =  =  *  =  =  =  =  =  = 

boxprlnttyl -4, xl.x2, 'STATUS  OF  A  U  V  OPERATING  PARAMETERS  :); 

write  (tabxy  (xl ♦  5,y  1 » 6).'AUV  DEPTH  t  In  1  :  '); 

write  (tabxy  (xl ‘S.y  1 ‘71,'AUV  SPEED  t  Ft  /  sec  ]  :  ); 

write  (tabxy  (xl ‘5,y  1  »%),'AUV  PITCHRATE  I  Deg  /  sec  ]:  '); 
boxprlnt(yl«10,xl,x2,'A  U  V  CONTROL  STATUS'); 

write  (tabxy  (xl  v5,y  1  ♦  12),'CURRENT  TARGET  DEPTH  ; 
write  (tabxy  (xl*5,y  1*1 3), 'CURRENT  MODE  ;  '); 

write  (tabxy  (xl*5,yl*t4).’CURRENT  MANEUVER  ; 

boxprlnt(yl*18,xl,x2, 

PRESS  KEY  FI  ..TO  ENTER  NEW  TARGET  DEPTH.  '); 

boxprlnt(yl*lS,xl,x2, 

'PRESS  KEY  F2  ..  TO  STOP  ACTIVE  CONITIOL  AND  RESET.'); 
boxprlntcy  1*20, xl,x2, 

PRESS  <  ESC  >  ..  TO  EIQT  ACTIVE  CONTROL.  '); 

end;  (  - RunModeScreen -  ) 
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procedure  UpdateRunModeScreen  (updat edepth.updat e speed. upda t epltcbr at e  :  real. 

updatetargetdepth  ;  integer; 
updateBode:  act  1 veCONTROLaode  ; 
updateattltude  :  au v a 1 1 1 1 uoe ): 

(  This  aodule  updates  the  Closed  Loop  Control  Run  Mode  Screen  with  updated 
display  paraaeters.  Updates  occur  In  Intervals  specified  by  updatelncreaent 
interval  declared  In  ClosedLoopControl  procedure.  ) 

begin  (  -  L'pdateRunModeScreen  -  1 

{  UPDATES  STATUS  OF  A  U  V  OPERATING  PARAMETERS  1 

wrlteln  Itabxy  1x1  »  37  ,y  l  »  Sl.updat  edepth;6;2); 
wrlteln  (tabxy  (xl  *  37.y  l ‘Tl.updatespeediS:;): 
wrlteln  (tabxy  (xl  •- 37  ,y  1  •- Sl.updat  epitchr  a  t  e:6;2); 

(  UPDATES  THE  A  U  V  CONTROL  STATUS  1 

write  (tabxy  (xl 30,y  1  1 2),updat  et  arge  tdept  h;2); 
case  updateaode  of 

run  :  wrlteln  (tabxy  (xl ••  30,y  1 » 1 3),’RUN 
reset:  wrlteln  (tabxy  (xl  *  30,y  1 »  1 3),'RESET‘); 
exit  :  wrlteln  (tabxy  (xl  » 30,y  1  » 1 3),'EX!T 
end; 

case  updateattltude  of 

aalntaln  :  wrlteln  (tabxy  (xl * 30.y  1 » 1 4>,'MA1NTA1NING  DEPTH 
cllab  :  wrlteln  (tabxy  (xl  ‘ 30,y  1 »  1 4),  CLIMBING  TO  TARGET  DEPTH'); 

diving  :  wrlteln  (tabxy  (xl  ‘ 30,y  1  *  1  4>, 'DIVING  TO  TARGET  DEPTH  ); 

end; 

end;  {  -  UpdateRunModeScreen  - -  ! 


procedure  GetDlgltalSensoryOata  (  var  depthanalogvol t  s .speedanalogvol t  s, 

pitchrateanalogvolts  ;real) 

(  This  procedure  uses  PCLAB  routines  to  saaple  selected  Input  teleaetry 
channels  troa  the  AUV  and  digitizes  these  Inputs  and  aultlplles  the* 
by  the  specified  gains. 


DT  :801-A  /  DT  707  Board  set  up: 


channel  1  -  AUV  depth  Input 

channel  2  -  AUV  speed  Input 

channel  3  -  AUV  pitchrate  Input 


const 


{  These  are  artificial  gains  used  to  slaulate  AUV  teleaetry  during  prograa 
developaent.  One  signal  froa  a  signal  generator  {•■/-  1.2S,  9  Hz, 
characteristic  ot  the  pitchrate  signal)  Is  Input  to  all  3  Input  channels. 

Gains  are  applied  to  slaulate  the  actual  values.  These  and  their  appli¬ 
cation  In  the  procedure  body  should  be  reaoved  after  prograa  developaent 
Is  coapleted.  I 


depthgaln  ^  1.0; 

speedgain  -  2.0; 

pttchrategaln  =  1.0; 
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Jonvert  tbe  digitized  Analog  Data  Values  for  speed,  depth,  pitchrate  to 
analog  voltage  values.  The  algorlths  for  this  conversion  Is  found  In 
Appendix  0  of  the  PCLAB  docuaent a t Ion.  ) 


dept hanalogv ol t s  (  depthadv  •  (depthpfs -depthaf s)/noc  ) 

speedanalogvolt s  (  speedadv  *  (spdpf s - spdaf s),  noc  ) 


^  depthafs: 
'  spdafs; 


pi t chr a t eanalogvol t s  (  pltchrateadv  * 

(pltchratepf  s  -  pit  chr  a  t  eaf  s  )/noc  ) 

'  pltchrateaf 


end;  (  - procedure  GetDlgltalSensoryData  -  1 

procedure  Errorvolts  (  tdepthvolts,  adepthvolts  :  real; 

var  derrorvolts:  real, 

var  attitude  ;  auvattltude  ); 

(  This  Bodule  represents  the  ~AUV  Model  Reference  Stale  Space."  Actual 

depth  teleaetry  and  the  target  depth  are  coapared  and  a  voltage  difference 
Is  coaputed.  This  difference  is  then  "dropped"  through  a  voltage  filter 
to  deteralne  If  the  difference  If  within  an  acceptable  tolerance,  or  If  a 
corrective  dlveplane  coaaand  Is  necessary.  A  "aodel  gam"  Is  applied  to 
the  voltage  difference  and  an  errorvoltage  Is  calculated  and  passed  to  tbe 
aaln  prograa  for  dive  coaaand  generation.  Although  these  paraaeters  are 
single  valued.  In  a  aultl-state  control  prograa  these  paraaeters  could  be 
lapleaented  as  arrays  and  the  aodel  gain  array  could  be  the  result  of  a 
real-tlae  prograa  running  synchronously  with  the  aain  control  prograa.  ) 

{  COMPUTATIONAL  SIGN  CONVENTION;  The  voltage  difference  Is  coaputed  as  the 
difference  between  TARGET  DEPTH,  or  desired  AL'V  depth,  and  the  ACTUAL 
DEPTH.  A  PLUS  voltage  DIFFERENCE  generates  down  dive  plane  coaaand; 

A  MINUS  voltage  DIFFERENCE  generates  an  UP  dive  plane  coaaand.  ) 


cons  t 

dept  hcon  t  rolt  olerence  =  0.1; 

aodelgaln  =  1.0 

var 

volt  sdlf  f  erence  ;  real; 


This  slauJates  a  aodel  referenced  ) 

(  gain  paraaeter  ) 


begin  ( - Errorvolts 


volt sdlfference  tdepthvolts  -  adepthvolts; 


(  These  are  AUV  to  DT  ;801-A  OT  707  hook  up  board  channel  configurations, 
conversion  and  coaputatlonal  arguaents. 


depthchannel 
depthpf s 

=  1; 

=  *10.0; 

(  AUV  output  to  DT-707  Input 
(  Peak  depth  signal  value 

channel 

assignment ) 

dept  hmf s 

=  -10.0; 

{  lllnlaua  depth  signal  value 

) 

speedchannel 
spdpf s 

-  f\  . 

=  ►lO.O; 

(  AUV  output  to  DT-707  Input 
(  Peak  speed  signal  value 

channel 

ass ignaent ) 

spdmt  s 

=  -10.0; 

(  Minimum  speed  signal  value 

) 

pltchratechannel  7; 
pUchratepts  =  ►10.0; 
pltchrateafs  -  -10.0; 


I  AUV  output  to  DT-70T  Input  channel  assignment) 
(  Peak  pltchrate  signal  value 

{  Mlniaua  pltchrate  signal  value  1 


noc  =  4096;  I  Nuaber  of  Codes;  conversion  resolution. 

The  DT  2S01-A  pertoras  a  12  bit  conversion. 
NOC  =  <2  *  conversion  bits),  le  4096  ) 


(  SetUpAdc  and  ADConTrlgger  PCL  function  arguaents 

;  p  6-8  PCL  docuaentatlon  ) 


boardnua 


=  1: 


nuaa2dcban  =  3; 

tlalngsource  =  2; 

adcgain  ^  1; 

startchannel  -  1; 

endchannel  =  3; 


(  --  Sets  a  external  trigger, Internal  clock  1 
{  Sets  the  A/D  gain;  1,2, 4. 8  are  options  ) 


speedadv, 

depthadv, 

pltchrateadv, 

stgnaladv, 

counter, status, 

cbanua,l,J 


begin 


{  Signal  analog  data  value  ) 

Int  eger; 

- procedure  Ge tOlgl t alSensory Da 1  a  - 


(  Set  up  the  OT  2S01-A  board  to  take  data.  ) 

status  :-  SelectBoard  (boardnua); 

(  Set  up  the  OT  2801-A  board  to  take  data  froa  3  input  channels;  Data 
saapllng  Is  Initiated  by  the  ADConTrlgger  single  channel  saaple  of  the 
depth  channel  and  then  single  ADC  value  samples  of  the  speed  and  pltchrate 
follow.  The  Trigger  Is  connected  to  the  OT  707  board  at  terainal  49  from 
a  signal  generating  source.  ) 

status  ADConTrlgger  <  depthchannel,  adcgain,  depthadv  ); 
status  ;-  AOCValue  <  speedchannel,  adcgain,  speedadv  ); 
status  ;-  AOCValue  (  pltchratechannel,  adcgain,  pltchrateadv  ): 


53 


( 


Control  volta<e  filter 


) 


{  These  conditions  check  if  depth  li  within  tolerence.  If  so  a  aero  error 

is  assigned  so  as  to  result  in  a  zero  dlveplane  coaBand.  ) 

if  (  volt  sdlf  f  erence  >  0)  and 

(  abs( voltsdlfferencei  <-  depthcont roll olerence  )  then 

begin 

derrorvolts  0.0; 
attitude  aaintain: 

end 

else  if  (  volt  sdlf  ference  <  0)  and 

(  absivolt sdlf ference)  <=  dept hcon t rol t ole rence  )  then 

begin 

derrorvolts  0.0; 

attitude  aaintain; 

end 

I  This  condition  checks  If  actual  depth  Is  less  than  target  *  tolerence. 

In  this  case  a  DIVE  coaaand  Is  necessary  to  correct  depth.  1 

else  If  (  volt  sdlf  fe rence  >  0)  and 

(  abs( vo 1 1 sdl f f e r ence )  >  dept hcon t rol t ole rence  )  then 

begin 

derrorvolts  volt  sdlfference  *  aodelgain; 

attitude  diving; 

end 

(  This  last  condition  checks  to  see  If  the  actual  depth  Is  more  than  target  • 
tolerence.  In  this  case  cllab  coaaand  Is  necessary  to  correct  depth.  ) 

else  If  (  volt sdl f ference  <  0)  and 

(  absivolt sdl f ference)  >  depthcontroltolerence  )  then 

begin 

derrorvolts  ;■  v  olt  sdlf  ference  •  aodelgain; 
attitude  cllab; 

end; 


end;  ( - Errorvolts 


procedure  GenerateOlveplaneCoaaand  (  dtvecoaaandvolt  s  :  real  ); 

(  This  procedure  CONVERTS  the  analog  ERRORVOLTS  signal  to  a  digital  equi¬ 
valent  voltage  and  sends  this  as  a  COMIIAND  to  the  AUV  Interface  device 
for  transalsslon  as  a  DIVE  PLANE  COMMAND.  It  uses  a  single  DACValue 
routine  call.  I 

const 

(  DT  280X-A  DIGITAL  TO  ANALOG  Conversion  declarations  ) 

d2achannel  =  0; 
pfs  =  10; 
afs  =  -  10; 
noc  =  4096; 

var 

dlgltaldatavalue,  status  ;  Integer; 
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function  ConvertAnalojiDljltal  (  analo<value  .  real  );  Integer; 

{  This  function  converts  analog  signal  volts  to  an  equivalent 
digital  value.  See  App  D  of  PCLAB  book.  ) 

var 

temp  :  real; 

begin 

temp  (  analogvalue  -  mfs  )  •  (  (noc  -  1)  (pfs  -  mfs  )  ); 
con  v  e  r  t  analog  2  dlgl  t  al  round  (  temp  ); 

end; 

begin  (  -  Gene  r  a  t  eOlvePIaneCommand  -  ) 

dlgltaldatavalue  convertanalog2dlgltal  (  dlvecommandvolt s  ); 

(  status  Initialize;  ) 

status  selectboard  (1); 

status  dacvalue  (  d2achannel,  dlgltaldatavalue  ); 

(  status  terminate;  I 

end;  (  -  GenerateOlvePlaneCommand  -  ) 


procedure  Ini t lallzeParame t e r s  ; 

(  This  procedure  Initializes  all  declared  control  and  display  parameters  to 

zero.  ) 

begin  (  - procedure  Int t lallzeParame t er s  ) 

auvdepthvolts  ;-  0.0; 
au  vspeedvolt  s  ;■  0.0; 
auvpltchratevolt  s  :=  0.0; 
auvdepth  0.0; 
auvspeed  :=  0.0; 
auvpitcbrate  ;-  0.0; 

end;  { - procedure  Ini t lallzeParame t ers ) 
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begin  {  - - -  Clo s edLo opCon  t  r  o  I  - 

actlveaode  run; 
inltlallzeparaaecers; 

repeat  (  -  Repeat  until  actlveaode  =  exit  -  ) 


repeat  (  -  Repeat  until  actlveaode  reset  - 

ClosedLoopControlScreen; 

GetTargetDepth  (  targetdepth,  t arge t dept hvo 1 t s  ); 

RunUodeScreen; 

while  (  not  keyhtt  (  aodereply,  aodereplyO)  do 
{NOTE:  THIS  IS  THE  rROGRAMHABLE  INTERRUPT  WHICH  IS  MASKED  BY  THE  PCLAB 

ROUTINES.  THE  USER  MUST  USE  A  CONTROL  -  BREAK  <  CNTRL->  TO  STOP  PROGRAM 
EXECUTION  AND  EXIT  THE  PROGRAM. 


begin 

upda t ecoun t e r  0; 

while  (  upda t ecoun t e r  <  updatelncreaent  )  do 
begin 

GetOlgltalSensoryOata  (auvdeptbvolts.auvspeedvolts, 

auvpitchratevolts  ); 

Errorvolts  (  t arge t dept hvolt s,  auvdeptbvolt s  , 
dept  herr  or  volt  s.  attitude): 


Genera t eDIveplaneCoaaand  (  deptherrorvolt s  ): 
upda t ecoun t cr  updatecounter  *  1: 


end;  {  while  updatecounter  <  updatelncreaent  ) 

auvspeed  :*  convertspeed  (  auvspeedvolt s  ); 
auvdepth  convertdepth  (  au vdepthvolt s  ); 
auvpitchrate  .-  convertpitcbrate  (  auvpitchratevolts  ); 

Upda t eRunModeScreen  (  auvdepth,  auvspeed,  auvpitchrate, 

targetdepth,  actlveaode,  attitude  ); 

end;  (  while  not  KeyHIt  ) 

If  (ord(aodereply)  =  27)  and  (ordCaodereply 2)  =  59)  then 

actlveaode  :=  run  {  KeyHlt^Fl  I 

else  If  (ord(aodereply)  =  27)  and  (ordCaodereply 2)  60)  then 

actlveaode  :=  reset  (  KeyHlt^Fl  ) 

else  If  (ord(aodereply)  =  27)  and  (ordtaodereply 2)  =  0)  then 

actlveaode  ;=  exit;  {  KeyHIt-  ESC) 

until  (  actlveaode  =  reset  )  or  (actlveaode  -  exit  ); 


until  (  actlveaode 


exit  ); 


end; 


{ 


ClosedLoopControl 


1 


begin  C  -  S  t  a  t  us/-. ndCoBBand  - 

repeat 

StatusAndCoaaandScreen: 

GetKey  (  ",aode,aode2): 

If  (  ord  (aode)  -  27  )  and  (  ord  (aode2)  =  59  )  then 
begin 

clrbox2  (xl.i  I,x2.y2); 

ClosedLoopContrul, 

end; 

until  (  aode  In  ['Q'.'q'l  ); 

end;  {  -  - - -  S t a t  u  s AndC oaaand  - 

procedure  InltlallzeZeroOlgltalSlgnalOut; 

(  This  procedure  UUST  be  executed  as  the  first  procedure  called  In  the  aaln 
prograa  to  insure  a  zero  signal  out  on  the  2  output  channels.  Otherwise  the 
DT  2501  board  defaults  to  a  atniaua  full  scale  output.  ) 

cons  t 

dlgltalchanO  -  0; 

dlgltalchanl  -  1; 

dig!  t  alcoaaandboard  ~  1; 


var 

status. 

digit  alda  t  a  value  :  Integer; 
begin 

dlgltaldatavalue  2048;  {  This  will  be  converted  to  an  equivalent 

zero  analog  signal  out  on  a  12  bit 
resolution  converter  like  DT  2801  -A.  ) 

status  Initialize; 

status  :  selectboard  (  dlgttalcoaaandboard  ); 
status  dacvalue  (  dlgltalchanO,  dlgltaldatavalue  ); 

status  dacvalue  (  dlgltalchanl,  dlgltaldatavalue  ); 

status  teralnate; 

end; 

procedure  OeactlvateADBoardAndExlt Prograa; 

(  This  procedure  deactivates  the  DT  2801  A  board  and  presents 

an  exit  screen.  } 

var 

status  :  Integer; 

begin  (  - DeactlvateADBoardAndExltPrograa  -  1 

status  :=  teralnate; 
clrbox2  (xl,yl,x2,y2); 
boxprlnt  (yl’-lO.xl.xZ, 

THIS  CONCLUDES  YOUR  AUV  AUTOPILOTTING  SESSION  ,  BYE'l; 
end:  {  - DeactlvateADBoardAndExltPrograa  -  1 


begin  {  - 

tnltlaUzeZeroOlgltalSlijnalOut; 

clr  scr: 

repeat 

MalnMenu  (  option  ): 

It  (  option  in  ['R'.'r'])  then 
begin 

repeat 

begin 

S t at u sAndCouand  <  controlaode 
end: 

until  (  controlaode  In  ['q'.'Q']): 
end; 

until  (  option  In  ['Q'.'q  1); 

Oeactlvat  eADBoa  rdAndExI t Pr ograa; 

END.  (  . . 


MAIN  PROGRAM 


); 


MAIN  PROGRAM 
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